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ABSTRACT 


Maps, as treated in traditional Robot Motion Planning are not always black 
and white. Any terrain map can be divided into different regions depending upon the 
negotiability in the terrain. For some regions the negotiability may be so poor that 
if start and destination are outside it, it should always be avoided for Path Planning 
purposes. In this work an algorithm is presented to find such convex polygonal regions 
termed as True Obstacles. Such knowledge makes the path planning approach simpler. 

There is an exact analogy between light rays and minimum cost paths at the 
boundaries of uniform cost regions. The algorithm for determining true obstacles is 
based on Snell’s Law. We also present a search algorithm to find the minimum cost 
path which passes through a given sequence of boundary segments. 
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Chapter 1 


Introduction 


In traditional robot motion planning [Latombe], regions have been treated in black and 
white i.e., either obstacle or free space. The problem of path planning in such black and 
white regions has been studied extensively. However, in practice we come across regions 
having finite costs [Mitchell], [Rowe and Richbourgj. The problem of finding minimum 
time path through general terrain faced by a tank is one such example. Here, several 
types of informations are available, for example, the nature of terrain : forest, river, 
scrub, sand etc. (Fig. 1.1) or the lay of the land i.e., slopes along the path (Fig. 1.2). 
Even in ordinary mobile robot traversal, the mobile robot maintains a probabilistic, 
geometric map of the smroimdings using sensors. Consequently the emerging map is 
not black and white, (e.g.. Certainty Grid [Moravec]), though the regions here, are in 
black and white, the incompleteness of the robot’s knowledge makes the cost of the 
region variable. 

Finite costs actually can be asssigned to even traditional "obstacles" even 
a piano can be moved out of the path when installing new furniture, say. However, 
the assiunption used in traditional motion planning is that for most obstacles, under 
normal navigation conditions, such costs are very high as to make it infeasible to 
attempt it. One of the main objectives of this work is to investigate the limitations of 
this assumption. The question we ask is: under what conditions is it valid to assmne 
that an obstacle is better bypassed? Such obstacles, which we call "True Obstacles", 
are one of the main issues discussed in this work. 
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Figure 1.2; A slope map of general terrtain 
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The navigation problem where different costs are associated with different 
regions is termed as weighted region problem. This is a generalization of the well- 
stii-died obstacle avoidance problem, as the obstacle avoidance problem is simply the 
weighted region problem in which the costs or weights are either 1 or oo depending on 
wtiL ether a region is free space or obstacle. Multiple terrain costs are essential to model 
an.y outdoor terrain. How costs should be assigned to regions is a complex problem, 
is largely application-dependent. 

The model of cost used in some applications is the reciprocal of maximum 
sp'eed in each region, where minimizing the cost of the path means minimizing the time 
rec3,uired for a vehicle to execute the path. The cost of a region may change with the 
veliicle, the task, and other attributes of the problem such as fuel left, weather, etc. 
Tfae variable cost problem has been studied mostly in the context of terrain navigation. 

Negotiability of the vehicle in a region decides the cost of the region. Soil 
stjrength and slope influence the negotiability in a region. Soil strength depends on the 
soil type, soil depth and moisture content. Slope has a direction which makes the cost 
araisotropic and hence is quite difficult to handle. In military and nuclear applications, 
tli-«re may be regions which correspond to the high risk, either from enemy threat or 
dute to radiation exposure. Costs can be assigned to traveling in these risky regions as 
we:ll. Higher cost represents a poor negotiability in the region. 

To simplify the complexities of modelling the full terrain data, most models 
[N/Iitchell], [Rowe and Richbourg] approximate the terrain with uniform isotropic cost 
re.gions. In this work also, we have assumed that the map can be decomposed into 
uiaiform isotropic cost regions. Further, we assume that the terrain features can be 
modelled using a polygonal representation [Rowe and Richbourg]. This is a widely 
used approximation in many domains. Hence, it is assumed that the map can be 
decomposed into polygonal regions with uniform isotropic costs. 

When a map is represented as polygonal regions with uniform isotropic costs, 
sometimes the cost of a region is so high that no outside path should enter it. Such 
regions axe called True Obstacles. The two undersaid examples make the concept of 
true obstacles more limpid. 
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Example 1 ; Consider a polygonal approximation (Fig. 1.3) of a part of the general 
terrain given in Fig. 1.1. Here, for any start and goal outside the region marked 
"Hills", an optimal path can never go through it, due to its high cost. Such a 
region is called a True Obstacle. 

Example 2 : For reaching goal point G (Fig. 1.4) from start point S, the stool can be 
moved (dashed line) or one can go around. Under normal circumstances, it might 
be pragmatic to move the stool. But if a heavy flowerpot is kept on the stool, it 
might be desirable to avoid moving the stool, unless the objective is to move the 
stool itself. Stool with heavy flowerpot, thus, becomes a true obstacle. The cost 
of moving some objects (e.g., the piano) is so high that for all practical purposes 
it may be considered to be a true obstacle. Thus, if costs can be assigned, such 
problems can also be handled by the concept of true obstacles. 

Chapter 2 deals with true obstacles in more details. An algorithm to find the condition 
under which a region becomes a true obstacle is also presented in this chapter. 

There is an exact analogy between the behaviour of light rays at the boundary 
of two media and minimum cost path at the boundary of two homogeneous cost regions. 
Chapter 3 discusses how this analogy can be utilized to find the minimum cost path in 
a map represented as uniform cost regions. 

Conclusion of the present work is elucidated in chapter 4. Scope for extending 
the present work is also discussed in this chapter. 




Figure 1.3: Terrain Obstacle - Here, for any start and goal outside the region marked 
"Hills", an optimal path can never go through it, due to its high cost. Such a region is 
called a True Obstacle. 



Figure 1.4; Movable Obstacle - To reach G from S, the stool can be moved (dashed 
line) or one can go aroimd. The cost of moving some objects (e.g., the piano) is so high 
that for all practical purposes it may be considered to be a true obstacle. 





Chapter 2 


True Obstacles 


For the purpose of path planning, a given map can be divided into different regions 
depending on the cost of moving. Sometimes the cost of moving in a region is so high 
that no outside path should enter it. Such regions are called True Obstacles. When 
start and goal points are outside such regions, these act like obstacles, even though finite 
costs are associated with such regions. Finding true obstacles in a map simplifies the 
path planning problem. In this chapter a computational geometry approach for finding 
true obstacles is presented. The algorithm proposed applies to convex polygonal regions 
and finds true obstacles. 


2.1 Nomenclature 

Following terms are used in this chapter (Fig. 2.1). 

• Convex perimeter For a region, the perimeter of the smallest convex polygon 
enclosing the region is its convex perimeter. 

• Convex rope length‘^‘”(Pccit;) •- For any two points S and G on the perimeter of a 
region, the rope length joining S and G in counter clock wise direction along the 
convex perimeter of the region is Pccw{S, G) {S-P 1 -P 2 -G}. 
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Figure 2.1: Nomenclature - Explains the terms used in the maximum chord-ratio the- 
orem and the true obstacle algorithm. 

• Convex rope length‘s (pctu) > For any two points S and G on the perimeter of a 
region, the rope length joining S and G in clock wise direction along the convex 
perimeter of the region is Pcur(S, G) {S-Q 1 -Q 2 -G}. 

• Peri-dist (p) :- For any two points S and G on the perimeter of a region, p(S, G) 
is the minimum distance from S to G along the convex perimeter of the region. 
Thus 

p(S, G) = Min(pea„(S, G), Pe„,(S, G)) 

• Maximum peri-dist (pmax) If for any two points S and G on the perimeter of a 
region pccw equals p^w, the p(S, G) becomes maximum. Thus, p^ax for a region is 
half its convex perimeter. 

• Perimetric image :- For any point P on the perimeter of a region, the point at a 
distance pmax from the point P along the convex perimeter of the region is called 
the perimetric image of P. 

• Antipodal edge :- For any edge E of a convex polygon, the edge containing peri- 
metric image of first vertex of E is called the antipodal edge of E. Antipodal pair 
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contains an edge of a convex polygon and its antipodal edge. 

• Chord (k) For any two points S and G on the perimeter of a region, the straight 
line path connecting S and G is called k(S, G). Thus, any chord of a convex region 
lies completely inside it. 

• Chord-ratio (A) For any two points S and G on the perimeter of a region, the 
ratio of p(S, G) and k(S, G) is called A(S, G). Maximum chord-ratio over all 
points S and G on the boundary of a region R is called the Maximum chord-ratio 
of R and is denoted by AtooiCR). For example. Maximum chord-ratio for a square 
is 2. 

• Chord-angle (0) :- For any two points S and G on the perimeter of a convex 
polygon, the angle between «(S, G) and the edge containing G in the direction 
of p(S, G) is called ^(S, G). 

If G is a vertex of the polygon, it is shared by two edges. In such cases, traversing 
from S to G in the direction of p(S, G), the first edge containing G is to be chosen 
for finding 0(S, G). 

If G is perimetric image of S, there £ire two values of 0(S, G) : 

dcw(S, G) in clockwise direction from S to G. 

^cau(S, G) in counter clockwise direction from S to G. 

• Critical chord-angle (0cr) For any two points S and G on the perimeter of a 
convex polygon the critical chord-angle is given by 

MS,G) = cos 

Note that, 

0Cr(S, G) = 0cr(G, S) and 0^ < 9cr < 90“ 



Definition ; A convex region R, having cost index Cr and surrounded by regions 
having maximum cost index Cs, is a True Obstacle iff, the ratio of Cr and Cs 
is greater than the Maximum chord-ratio of R (Xmca (R ) )■ 
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Consider any convex region R, having cost index Cn and surrounded by 
regions having maximum cost index Cs such that 

> A™.{R) 

Then the cost of straight line path connecting any two points S and G on the perimeter 
of R is C/jX K, where k is the chord(S, G). 

And cost of the shortest path connecting S and G along the perimeter 
of R < CsX p, where p is the peri-dist(S, G). Hence, the ratio of two costs is 

Cr X K _ 

Cs X p 

> 

Now, since ^ > X^ax, this ratio is always greater than unity. Hence, the cost of 
path through region is always greater. For points not on the perimeter, the ratio will 
be even greater. Hence, for any start and goal points outside R, the minimum cost 
path connecting start and goal points cannot enter R. Hence, it is a True Obstacle. 
Therefore, for any convex region the condition under which it becomes True Obstacle 
can be calculated by the geometry of the region itself. 


Cs A 
^x^ 


2.2 Maximum Chord- ratio Theorem 


Theorem : For any pair of points S and G on the perimeter of a convex polygon 
R, chord-ratio (\(S, G)) to be maximum (\max(R)), it is necessary that 

1. Neither S nor G can be a vertex. 

2. 9(S, G) = e(G, S). 

3. e(S, G) > 6cr(S, G). 

In addition, 

4. ife(S, G) > ecr(S, G), p(s, G) = Pmox(R). 
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5. if 9 (S, G) = 9cr(S, G), 

There is a set of parallel chords with the same chord-ratio and 
one of these chords is between two perimetric image points. 


Proof : 


Proposition 1 : Consider S as any vertex of a convex polygon R shared by two edges 
el and e2 of R and G as any point on any other edge e3 of R. ^2 ^3 are the 

angles between chord(S, G) and el, e2, e3 respectively (Fig. 2.2). 


S being a vertex, (f >2 > 4>i 


( 2 , 1 ) 


Consider points S' and G' on edges el and e3 at a distance x from S and G respectively 
such that p(S', G') = p(S, G). 

Then, A' = k'^ — = 2a;^[l — cos(^i — ^3)] + 2k£c(cos ^3 — cos ^1) 

dA' 

■ 2a; [1 — cos(^6i — ^3)] + «;(cos <j)z — cos 


dx 


dA’ 

As a; — » 0, = k(cos <f >3 — cos ^1) 

dx 


( 2 . 2 ) 


Now consider points S" and G" on edges e2 and e3 at a distance x from S and G 
respectively such that p(S", G") = p(S, G). 

dA" 


Then, as x — ^ 0, ^ — = k(cos ^2 ~ cos (f>z) 
dx 

From equations (2.1), (2.2) and (2.3) there are three cases. 


(2.3) 


1. cos^3 > cos(f>i > cos<^2! making ^ negative. 

2. cos^i > cos^3 > cos^2 making ^ and ^ negative. 

3. cos^i > cos^2 ^ cos^3 making ^ negative. 

- Thus, ^ is always negative in some direction. Hence, chord-ratio cannot be maximum 

at a vertex. 


□ 




Figure 2.2: Proposition 1 - A^^(R) cannot occur at a vertex of Region R - For 
X 0, A(S, G) is smaller than at least one of A(S', G') and A(S", G"). 



Figure 2.3: Proposition 2 - A^ cannot occur at a pair of points S and G, if 
e{S, G) ^ e{G, S) - if 0(G, S) > 0(S, G), A(S', G') > A(S, G), for X ^ 0. Similar 
is the case when 9{S, G) > 0(G, S). 
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Proposition 2 ; Consider any two boundary points S and G on a convex polygon 
R, such that ^(G, S) > ^(S, G) i. e., <j )2 > 4>i (Fig. 2.3). Without loss of generality, let 
the peri-dist (p(S, G)) be measured in ccw direction. Consider two boundary points S' 
and G' at a distance x from S and G respectively along the boundary of R, such that 


p(S', G') = p(S, G) and 9{G\ S') < 9(0, S) 

Hence, = 2 a:^[l — cos(<^2 ~ — 2 /cs(cos (pi — cos <p2) 

o- i j f fr. «(cos - cos ^2) \ . 

Since, (j >2 > for x € 0, — — — — which is a non-empty set, 

V 1 - cos{<p2 - <Pi) J 


k'^ - < 0 

OR A(S', G') > A(S, G) 


Hence, if 9(S, G) < 9(G, S), A(S, G) cannot be maximum. Similarly, 
if 9(S, G) > 9(G, S), A(S, G) cannot be maximum. Hence, 0(S, G) = 0(G, S) is a 
necessary condition for A(S, G) to be maximum. 


□ 


Proposition 3 ; Consider any two boundziry points S and G on a convex polygon R 
(Fig. 2.4). Without loss of generality, let the peri-dist (p(S, G)) be measured in ccw 
direction. Consider a boundary point G' in the direction of reducing peri-dist, i. e., 
p(S, G') = p(S, G) - X = p - X 

Now, k '^ = + x ~ — 2 xk cos 9 

Hence, A = A'^ - A^ 

= ( P^ + a;^-2px "I /p^\ 

\K^ + x^ — 2 xkcos9) 


As Denominator — k'^ = positive. 



s 



Figure 2.4: Proposition 3 - A^axCR) cannot occur at a pair of points S and G, if 
0(S, G) < 0cr(S, G) - In such a case, we can always choose a point G' in the direction 
of reducing peri-dist as shown, such that A(S, G') > A(S, G). 


As 


Ai 

dAi 


a: — 0, 


dx 

dAi 

dx 


= Numerator = x^{k^ — p^) + 2pKx{p cos 9 — k) 
= 2x{k^ — p^) + 2pK(pcos 9 — k) 

= 2pk{p cos 9 — k) 

= positive for p cos 0 >k i. e., 9<9cr- 


Hence, if 0(S, G) < 0cr(S, G), A(S, G) cannot be maximum and 
0(S, G) > ^Cr(S, G) is a necessary condition for A(S, G) to be maximum. 


□ 


Proposition 4 : Consider any two boundary points S and G on a convex polygon R 
(Fig. 2.5). Without loss of generality, let the peri-dist (p(S, G) < Pmaa:(R)) be measured 
in ccw direction. Consider a boundary point G' in the direction of increasing peri-dist, 
i. e., p(S, G^) = p(S, G) X = p x 

Now, -h -f ^XK cos 9 
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S 



Figure 2.5; Proposition 4 - Given 9{S, G) > 0Cr(S, G), A^ 3 ;(R) cannot occur at the 
pair of points S and G if p(S, G) < Pmax(R) - In such a case, we can always choose a 
point G' in the direction of increasing peri-dist as shown, such that A(S, G') > A(S, G). 

Hence, A = A'^ - 

— ( P^ + a;^ + 2pg; ^ 

+ 2xKCos0j 

As Denominator = k- k'^ = positive. 

Numerator = x^{k^ — p^) + 2pkx{k — pcos 0) 

2x{k~ — p^) + 2pk{k — p cos 9) 

2pk(k — pcos 9) 

positive for pcos 9 < k i. e., 9 > 9cr- 

Hence, if ^(S, G) > 0cr(S, G) and p(S, G) < Pmai(R), A(S, G) cannot be 
maximum and if 0(S, G) > 0cr(S, G), p(S, G) = Pmaj:(R) is a necessary condition for 
A(S, G) to be maximum. 


As X — > 0, 


Ai 

dAi 

dx 

dAi 

dx 


□ 
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Figure 2.6: Proposition 5 - If 0(S, G) = 0(G, S) = ^cr(S, G), there is a set of parallel 
chords with same chord-ratio. If this set does not include the chord between two 
perimetric image points, A,nai(R) cannot occur at this pair of points. 


Proposition 5 : Consider any two boundary points S and G on a convex poly- 
gon R such that 0(S, G) = ^(G, S) = 0cr(S, G). Without loss of generality, let 
the peri-dist (p(S, G) < Pmai(R)) be measured in ccw direction (Fig. 2.6). Consider 
two boundary points S' and G' at a distance x from S and G respectively, such that 
chord(S', G') is parallel to chord(S, G). 


Now 



p' p + 2x 
k' k-\-2x cos 9 

p / p + 2x \ 

K \p + 2x J ’ 


since. 


p -1- 2a: ^ 0. 


Thus, for a series of parallel chords having 9 = 9cr, the increase in peri-dist and the 
increase in chord are proportional so as to maintain the chord-ratio constant. But, if 
these chords do not include the chord for which peri-dist is maximum, a chord with an 
end point on a vertex must be included in the series and referring to the proposition 
(1) above, peri-dist cannot be maximum at a vertex. Hence, this series of chords must 
include the chord of maximum peri-dist for A(S, G) to be maximum. 

□ 
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2.3 Verifying a True Obstacle 

Input : POLYGON, a convex polygon of structure type given below. 

Objective : Finding maximum chord- ratio (Amoi) for a convex polygon. 

Data Structure : 

1. VTX : Used for all points : X, Y co-ordinates. 

2. EDGE : Used for all line segments. 

• VI, V2 : represent the end points of the line segment. 

• LENGTH : represents the length of the line segment. 

• Edge is associated with a direction from VI to V2. 

• Line representation of type = t is used. 

3. POLYGON ; Used for the convex polygon. 

• NUMEDGE ; represents the total number of edges of the polygon. 

• EDGE : array containing all edges of the polygon. [0, . . . , numedge — 1]. 

• Pmax ■ contains maximum peri-dist (perimeter/2). 

• ^max ■ to be calculated by the algorithm. 

True Obstacle Algorithm : 

1. EDGE = first edge of polygon. 

2. IMAGE = antipodal edge of EDGE, 

shorten IMAGE to make IMAGE- VI = perimetric image of EDGE-Vl. 

3. MIN-CHORD = pmax. 

4. while (IMAGE 7^ first edge of polygon) 

{ 

if EDGE and IMAGE are parallel 

{ 

de = signed distance of EDGE-Vl from normal dropped on 
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EDGE from IMAGE- VI. 

if (de > 0 AND EDGE-LENGTH > de/2 AND IMAGE-LENGTH > de/2) 
the pair contains local min, locate, compare with existing MIN-CHORD, 
if smaller, store in MIN-CHORD. 

} 

else 

{ 

Find intersection point in terms of de and di, 
de = signed distance of intersection point from EDGE -VI, 
di = signed distance of intersection point from IMAGE- VI, 
if ((de + di) > 0 AND EDGE-LENGTH > (de + di)/2 AND 

IMAGE-LENGTH > (de -h di)/2) 

the pair contains local min, locate, compare with existing MIN-CHORD, 
if smaller, store in MM-CHORD. 

} 

Moving to next antipodal pair. 

if (EDGE-LENGTH < IMAGE-LENGTH) 

{ 

EDGE = the edge next to current EDGE in the 
edge sequence of the polygon. 

Shorten IMAGE to make IMAGE-Vl = perimetric image of EDGE-Vl. 

} 

else if (EDGE-LENGTH > IMAGE-LENGTH) 

{ 

IMAGE = the edge next to current IMAGE in the 
edge sequence of the polygon, 

Shorten EDGE to make EDGE-Vl = perimetric image of IMAGE-Vl. 

} 

else 

{ 

EDGE = the edge next to current EDGE in the 
edge sequence of the polygon, 

IMAGE = the edge next to current IMAGE in the 
edge sequence of the polygon. 
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Figure 2.7: Example polygon - Finding of a convex polygon. 

} 

} 

5- A^ = p^^/MIN-CHORD. 

Example : For the example polygon (Fig. 2.7), initially, EDGE = edge(PiP 2 ), 
IMAGE = (P 3 P 4 ) and after shortening the IMAGE, IMAGE = AP4. We then locate 
points S and G (non- vertices) on EDGE and IMAGE respectively, such that 61(8, G) 
= 9{Gf S), if exist, and store distance SG in MIN-CHORD. Then, move to next an- 
tipodal pair of edges. Here, IMAGE.LENGTH < EDGE.LENGTH giving IMAGE = 
edge(P 4 Pi) and EDGE gets shortened. This is repeated imtil all edges are scanned 
fully. If at any stage, distance SG < existing MIN-CHORD, store distance SG in MIN- 
CHORD. At the end MIN-CHORD contains the minimum of chords for all perimetric 
image points of the polygon. Maximum chord-ratio is then calculated. 

Complexity Analysis ; The algorithm starts with the antipodal pair for 
first edge of the polygon. These antipodal edges are either parallel or non-parallel, 
requiring constant time for testing. Next antipodal pair is then selected for testing. 
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As the algf)rithni moves to the next antipodal pair, at least one side (either IMAGE 
or EDGE) is advanced to the iK'xt edge in the edge sequence of the polygon. Further, 
algorithm s<'lectK antipodal pairs moving in only one direction (ccw or cw from the 
first edge of i>olygon), till it reaches the antipodal edge of the first edge, each edge is 
scanned only once. Hence, for a polygon of N vertices the algorithm is 0(N) complex. 

Proof of Correctness : The algorithm scans each edge of the polygon 
completely moving in one direction (ccw or cw starting from first edge). There are only 
two cases possible for antipodal pairs : the edges are either parallel or non-parallel. For 
both cases the algoritlun finds a local maximum chord-ratio, if it exists. The maYimnm 
of all such local maximum chord-ratios is selected as maximum chord-ratio (A^ai) for 
the polygon. Hence, by the maximum chord-ratio theorem, the result obtained by the 
algorithm is 

2.4 Genetic Algorithms 


Genetic Algorithms, or GAs, as they have been called, are effective search and opti- 
mization techniques. GAs are very different than traditional optimization techniques. 
GAs simulate the rules of natural genetics, in order to find out global optimum, analo- 
gous to "fittest in species". To solve an optimization problem by GA, we have to create 
a random population of points and assign their "fitness" values according to objective 
function value. Thereafter the following four operators are applied repeatedly to arrive 
at optimal solution : 

1. Reproduction 

2. Cross-over 

3. Mutation 

4. Evaluation of population 

Reproduction creates the next generation in such a way that individuals with 
higher fitness get more copies compared to those with lesser fitness. Cross-over creates 
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iK'w rliil<}n*n from the pan-nt g<'iif‘rati<)n, exploiting similarity among parents. Mutation 
is the op«>rafor which en.sun's diversity in the poi>uIation and guards against premature 
(•onverg<’nr«\ Finally, evaluation <»f population is noces.sary to guide the reproduction 
in next geiu rations. 

GAs have been effectively msed for a wide variety of problems in past and are 
able to get .solutions which are not possible by traditional optimization techniques. In 
an eff(»rt to verify the r<‘sults of our algorithm, which finds the maximum chord-ratio 
for a convex polygon, we compar<'d it with a GA implementation [Mukerjee, et al.] and 
obtain'd similar results. 


2.5 Results 

After impleirH'nting the algoritlun we tested it for randomly generated convex polygons. 
The tim<' for finding the maximum chord-ratio of the polygon increases linearly with 
the numlxT of vertices' (Fig. 2.8), which is in accordance with the complexity analysis. 
We compared the results obtained by our algorithm with the chord-ratios computed by 
applying GA for a large number of convex polygons, and found similar values. Some 
sampk' convex j>oygons with perimetric image points and chords of maximum chord- 
ratio are shown in Fig. 2.9 and 2.10. 

The number of generations and population size used in GA for testing purposes 
were 50, and chord-ratios found were similar upto sixth decimal place. 
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Figure' 2.8: Gra}>Ii of time complexity for the true obstacle algorithm. The linear natxire 
complies with comph'xity analy.sis result. 



Figure 2.9: Some sample randomly generated convex polygons tested by the true 
obstacle algorithm. Chord shown is between perimetric image points for which the 
chord-ratio is maximum (Atooi(R.))- 
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1 ,rr.n<; tested by the true obstacle algonthm. 
Figure 2 . 10 : Some more Joints tor which the chord-ratio is maxunum 

Chord shown is between perimetric imag i 

(A^a.(R))- 



Chapter 3 


Snell’s Law In Path Planning 


\\V hav<‘ s(H>u how a map can bo divided into polygonal regions having unif orm isotropic 
costs. Moving in such uniform cost regions is analogous to moving of light rays in media 
of uniform light .sj>e<>ds. When an optimum path crosses a region boundary it obeys 
SiK'H’s Law. In this chapter we discuss how to utilize such optical analogies in path 
planning. 


3.1 Minimum Cost Path 


If the minimum cost path between any two points lies completely inside a uniform cost 
coim'x r(*gion, it is a straight line connecting the two points. This is because, in order 
to minimize th<* cost of such a path, we have to minimize the path length. Hence, 
it can be concluded that the minimum cost path between any two points in a map 
represented as uniform cost regions, is piecewise linear, changing its direction only at 
region boundaries. We can, thus, formulate the problem of minimizing the cost of a 
path between two points separated by N regions as follows : 

Given N regions Ri, R 2 , . . . , Rjv with uniform costs Ci, C 2 , - • . , Cjv respec- 
tively (Fig.3.1), the path {S, Pj, P 2 , • - P]v-u G} from a point S in region Ri to a 
point G in region Rjv has total length 

[ (SPi) + E£"(Pi P.+i)+ (Piv-1 G)] 
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Th»’ f'lfH’i r«>ht of this path is 

TC (SP, C,) +E:"‘r (P. Pm,) Q.3+ (P;v-, G) Ca- 

Ilri'o. !’, is- a point on th«’ houiuiary of rcgioas R, and R,+a, for i = 1,2, . . . , — 1. 

Thf* cost minimization problem is that of selecting the points Pi, P 2 , 
Pv- ; s«* n.s to iniuimiz<* the total cost (TC) of the path between S and G. 


3.2 Snell’s Law and Path Planning 


Siioirs Law .states that the path of a light ray passing through a boundary between 
media A and B with indices of refraction and hb respectively, obeys the relationship 

sin 9a = fiB sin 9 b 


whero. 


0A. of incidence, is the ccw angle between the incoming ray and the normal 

to the region bf)undary at the point of incidence (Fig. 3.2). 

the Hiigh' f>f refraction, is the ccw angle between the outgoing ray and the normal 
to the' region boundary at the point of incidence. 

Refra<“tiv<‘ index (//) of a medium is given by the relation 

spe ed of light in vacuum 
^ speed of light in the medium 

Now, ktt us find out the behaviour of minimum cost path at a region boundary. Consider 
two points S in region A with cost and G in region B with cost (Fig. 3.3). Cost 
of the path from S to G is then given by 

path-cost = Ca^ + CbIb 

= CA{dl + x'^y^^ + CB[dG + {a-^??^^ 
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Figure 3.2: Snell's Law of refraction - Light ray refracts at the boundary of media A 
and B with indices of ndraction (Ja and tijj obeying the ralation sin 0^1 = ussinSB- 



Figure 3.3: Snell’s Law obeying path at the boundary of two regions is the minimum 
cost path. 
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Fur minimi/’.!!,'/. 

d 

—-(path-cost) = 0 

dx 

or C/iSinftA = CBsinOj) 

If we cuii-'idor fusts to he inv<>rs(‘]y proportional to velocity, tliis is Snell’s Law. Hence, 
SncH's Law uh< yin/ path at the boundary of uniform cost regions is the minimum cost 
path. 

('ritical Angle : When light rays enter from a denser medium into a rarer 
inediutn. tie* angle of incidence for wliich the angle of refraction is 90”', is called the 
critical ant/li aiid refraction in this case is called as critical refraction. If the angle of 
incidence is greater than th(' critical angle, light rays get totally reflected back into the 
denser inedinin. In path planning it simply means that if a minimum cost path crosses 
the regitni boundary and there is no angle of incidence less than the critical angle, it 
does not obey Snell's Law. The critical angle is given by 

9cr = sin~\CB/CA), Cb < Ca- 

Th<‘ ininimuin cost path doesn’t always behave similar to the light rays in analogous 
optical media. Example 1, bcilow, shows a case where light rays cannot reach goal point 
an<i th<‘ minimum co.st path to the goal doesn’t obey Snell’s Law at region boimdary. 
In example.^ 2 and 3, paths followed by light rays in analogous optical media are not 
minimum co.st paths. 

Example 1 : If the minimum cost path has to enter from a high cost region to a low cost 
region, sometimes there is no angle of incidence smaller than the critical angle at 
any of the region boundaries (Fig. 3.4). Hence, no path obeying Snell’s Law, can 
entcir the low cost region to reach the goal. For light rays, these boundaries are 
like mirrors. The minimum cost path (S-P-G) in such cases doesn’t obey Snell s 

Law at region boundaries. 

Example 2 : When start point S and goal point G, both lie inside a high cost convex 
region surrounded by a low cost region (Fig. 3.5), light rays follow a straight Une 
path connecting S and G, lying completely inside the high cost region. In such 




Figure 3.4: Mirror boundaries - Although the minimum cost path is {S, P, G}, light 
will not be able to enter the low cost region, as the boundaries act like mirros. 

a case, it might be more economical to follow a path along the boundary, lying 
just inside the low cost region. Snell’s Law does not suggest such Tninim uTn cost 
paths. 

Example 3 : If st art point S and goal point G lying in a low cost region are separated 
by a high cost region such that the straight line path connecting S and G is 
normal at the high cost region boundaries (Fig. 3.6), Snell’s Law obeying path 
may not be the minimum cost path. 


3.3 Multiregion Snell’s Law 


To compute Snell’s Law obeying path from S to G separated by a region boundary (Fig 
3.3), we get the quartic equation 


+ A^x^ + A\x + Ao = 0 
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Whore, 


A 3 = 


A 2 = 
Ai = 
Af) = 


-2a 

cijo? - 4 ) - CHa? - 4 ) 

Cl -Cl 

huSjfil 

Cl -Cl 

a'‘4Ci 

Cl -Cl 


Hence, the complication in Multiregion Snell’s Law is that when we write 
down the equations that represent the local optimality criterion (Snell’s Law) at each 
edge, and then try to solve for the points where the path crosses edges, we get (N — 1) 
quartic equations in {N — 1) unknowns, where [N — 1) is the length of edge sequence 
(Fig 3.1) through which the refraction path is known to pass. Elimination among 
these equations yields a very high degree polynomial (of degree exponential in (iV — 1) 
[Mitchell]). 

In this chapter, we present an iterative search algorithm to find the Snell’s 
Law obeying path through a given sequence of edges. Basic idea is to cast a ray from S 
and find out the error at goal (G) end. The next ray is then cast to reduce this error. 
This is r(!peated until the error at goal end is less than the specified bound. 


Problem : To compute the Snell’s Law obeying path from a point S in region Rj to a 
point G in region Rjv, which crosses the boundary segments bi, b 2 , - . . , b^r_i of regions 
Ri, R 2 ) - ■ • 3 with uniform costs Cj, C 2 , . . • , C^v respectively (Fig.3.1). 


Nomenclature 

Limiting intercepts : These are the points on bl. If a ray is cast from S to Hmiting- 
left-intercept, after final refraction, G lies to the right of this ray. Similarly for 
limiting-right-intercept, G lies to the left of ray. Hence, Snell’s Law obeying path 
from S to G lies between limiting intercepts. During the search, difference between 
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limiting intercepts is successively reduced to find the required path. Initially these 
intercepts are the end points of bl. 

Errors : If a ray cast from S does not pass through G after refraction through last 
boundary segment, its deviation from G is the calculated-error. Aim is to reduce 
this error for next ray cast. Limiting errors are deviations of rays for limiting 
intercepts. If for any boundary segment, the ray does not intersect it or critical 
refraction occurs, error value is near oo, in the algorithm it is represented by 
HIGH-VALUE. If error is less than the threshold given, search is complete. 


3.4 Multiregion Snell’s Law Algorithm 


Algorithm : Computing the Snell’s Law path through a given sequence of boundary 
segments. 

Input : Start point S and Goal point G, given sequence of boundary segments, costs 
of regions. 

Procedure : 

1. Initialize the limits. 

limiting-left-intercept = 0.0. 
limiting-right-intercept = length of bl. 

/* Compute limiting-left-error. */ 

Cast a ray from S along limiting-left-intercept. 

Compute refraction path resulting from this ray. 
if for any boundary segment, ray does not intersect 
the segment or critical refraction occurs 
limiting-left-error = Negative HIGH-VALUE, 
else if jcalculated-error| < Threshold, terminate search, 
else limiting-left-error = calculated-error. 

/* Compute limiting-right-error. */ 

Cast a ray from S along limiting-right-intercept. 

Compute refraction path resulting from this ray. 
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if for any boundary segment, ray does not intersect 
the segment or critical refraction occurs 
limiting-right-error = Positive HIGH-VALUE, 
else if calculated-error < Threshold, terminate search, 
else limiting-right-error = calculated-error. 

2. Cast initial ray from S along initial intercept. 

if limiting-left-error == Negative HIGH-VALUE or 
limiting-right-error == Positive HIGH-VALUE 
initial intercept = mean of limiting intercepts, 
else initial intercept = weighted mean of limiting intercepts. 

3. do 

{ 

Compute refraction path resulting from this ray. 
if for any boundary segment, ray does not intersect 
the segment or critical refraction occurs 
if G is to the right of this ray 
limiting-left-intercept = present intercept, 
else limiting-right-intercept = present intercept. 

Cast next ray from S along 

next intercept = mean of limiting intercepts, 
else if I calculated-error I < Tlireshold, terminate search, 
else if G is to the right of this ray 

limiting-left-intercept = present intercept 
limiting-left-error = calculated error 
else limiting-right-intercept = present intercept 
limiting-right-error = calculated error 
if limiting-left-error == Negative HIGH-VALUE or 
limiting-right-error == Positive HIGH-VALUE 
Cast next ray from S along 

next intercept = mean of limiting intercepts, 
else Cast next ray from S along 

next intercept = weighted mean of limiting intercepts. 


} 
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For special cases, like parallel boundary segments, more efficient algorit hms can 
be used. To verify multiregion Snell’s Law algorithm, foilwing property of parallel 
boundary segments is used. 

Parallel boundary segments : If the boundary segments bj, b 2 , b;v_i of 
regions Rj, R 2 , ..., Rat with costs Cj, C 2 , Cat are parallel, angle of refraction 
for one bomidary segment becomes angle of incidence for the next boundary segment. 
Applying Snell’s Law at each boundary, we get the relation. 

Cl sin 9i = C 2 sin 62 = ‘ sin 

where and 9i+i are angles of incidence and refraction respectively, for boundary 
segments b„ i = 1, 2, . . . , iV — 1. 

Results : The algorithm is implemented and tested for S and G separated by upto 
25 boundary segments. Results for parallel boundary segments were also tested and 
found matching with the theoretical values. The algorithm converges quickly. Sample 
cases are given in Fig. 3.7 and 3.8. 











Chapter 4 


Conclusions 


We have seen in brief how a terrain map can be divided into different regions depending 
upon the negotiability in the terrain. In practice, the negotiability depends on many 
other factors e.g., time of moving during the day, season of year, presence of other 
vehicles, etc. All these factors influence the negotiability in the terrain in some or the 
other way. Also, we have assumed uniform isotropic costs which simplifies the path 
planning problem greatly. Cosidering all these factors, may ensure real world path 
planning, and eflfort in this direction is needed. 

The algorithm presented for finding the condition under which a region will 
become a true obstacle applies to convex polygonal regions. This gives better knowledge 
of the regions of a map, consequently, simpler algorithms can be applied for path plan- 
ning. In practice however, we come across terrain maps which cannot be decomposed 
into convex regions fully. Hence, for completeness, one needs to solve the algorithm to 
handle concave regions as well. For this, some of the concepts might require modifica- 
tion, e.g., chord for a concave region may not lie completely inside the region. 

The optics analogy needs careful study before using it for path planning 
purposes. The algorithm presented finds the minimum cost path that passes through 
a given sequence of edges. But the question is : how to select the sequence of edges? 
Research is needed for selecting the edges to be crossed during navigation through 
general terrain. 
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The concept of true obstacles tells which regions should be avoided during 
path planning. If we know which edges are to be crossed during navigation, the mini- 
mum cost path through given sequence of edges can be computed using the algorithm 
presented. Thus, the two algoritlims form tools for the general terrain path planning. 
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